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1. INTRODUCTION 

The interest in the domain of mobile robots and its automation has grown in the past few years. 
There are lots of research on the kinematics and dynamic modelling, and for the control system for 
the mobilization of the robot, which should satisfy its performance based on time and accuracy. Although 
several research were conducted on the control system [1], the implementation on an embedded board has not 
been mentioned involving memory management and low redundancy. There were several research related to 
various approaches to achieve the optimum control system and their respective simulation results proved to 
be optimum [1-6], but when used in a system or a robot, the output determines all these models to be sparse. 

Skid Steer Mobile Robots (SSMR) are the vehicles that can tract on all terrain condition. To move 
the SSMR on all terrain there must be a feedback determining the errors in its predicted parameters and 
the output parameters, which must be done autonomously by the embedded controller, which provides 
the actuation signals to all the wheels in terms of pulse-width modulation (PWM). This can be achieved by 
implementing the two control algorithms (PID and LQR) in the embedded controller Mbed LPC1768. 


2. SSMR MODELING 

The Skid Steering Mobile Robot is a four-wheeled high traction mobile robot, which are steered 
by differential drive. A strong controller is required to compute all the values of the mobile robot and hence 
Mbed LPC1768 is preferred taking cost effectiveness and speed of operation into consideration. The SSMR 
Model is observed through 3D CAD CATIA is shown in Figure 1. 
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Figure 1. CATIA model of SSMR 


A mathematical description of the dynamics of an SSMR moving on a planar surface is introduced 
in this section. The mathematical model of the vehicle can be divided into three parts: kinematics, dynamics 
and drive subsystems. Here, we focus on the first two blocks, 1.e., the drive and dynamics subsystems, and 
we use them for reference tracking control of both the linear and angular velocities. SSMR model as shown 
in Figure 2. 
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Figure 2. SSMR Model 


2.1. Dynamic modelling 

This process allowed a thorough study for the design and the load carrying capacity of the SSMR 
and the optimization in its weight, which is very beneficial for its control. In Figure 3 is schematic model of 
SSMR in global coordinate system. The main equation that describes the dynamic subsystem of the SSMR 
moving on a planar surface as shown in figure is given by (1): 


M (q) 7 +C (q) 1+ R (q) =B(q)t (1) 


Xg 





Figure 3. Schematic Model of SSMR in Global Coordinate System 


2.2. Drive model 

In Figure 4 is drive model. Four DC motors coupled with mechanical gears finally to the wheels 
drive the SSMR. Considering only one of the drives (Motor) and assuming remaining all motors to have 
same parameters, the relation between torque t and voltage uvacan be written as shiwn in (2-3). 
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Figure 4. Drive Model 


t=nK;iia (2) 
d l l 
Ugam La ET (i, )+ Raia+ nKewi (3) 


Where, 
i,is the armature current, 
Kiis the motor torque constant, 
N is the gear ratio (n > 1), 
L,and R, denote the series inductance and resistance of the rotors respectively, 
Keis the electromotive force coefficient, and 
W = [w w] T. 

The left w, and right w, sides angular velocities can be obtained from the following formulas as 
shown in (4-5) 

vx—present error, 


“oS —. (4) 


r 


vx—present error 


Ww, = (5) 


r 


The Matlab modelling of the drive is shown below in the Figure 5 
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Figure. 5 Drive model in Matlab 


3. CONTROLLER ALGORITHM 
3.1. PID controller 

PID is the basic linear control algorithm used in a system, which involved a constant feedback gain 
fed to the input. A PID controller determines error values as a difference between required value and measure 
process variables. PID involves three parameters 1.e. Proportional (P), Integral (I) and Derivative (D) where P 
is accountable for present values, I for past values and D for future values. Block diagram of PID controller 
as shown in Figure 6. 
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Figure 6. Block diagram of PID controller 


The basic governing equation of PID controller is given by (6): 


u (=K e(t)+K; f e(t)dt + Kp e (6) 


The values of P, I, D were manually tuned to obtain the best response with the help of 
matlabsimulation, which was then fed into the actual controller design for the SSMR as C program. Matlab 
simulation model of the controller design and its response can be observed in the Figure 7 and 8 below where 
PID controller is attached to drive model, which is derived earlier. 
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Figure 7. Flow Diagram of PID Controller 
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Figure 8. Response of PID Controller 


3.1.1. Implementation of LQR on NXP LPC 1768 microcontroller 

LPC 1768 controller has a 32-bit ARM Cortex-M3 core running at 96MHz. It also has 512KB flash, 
32KB RAM and lots of I/O pins, which are required for the operation of SSMR. Pin diagram of Mbed 
LPC1768 as shown in Figure 9. 
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Figure 9. Pin Diagram of Mbed LPC1768 


Algorithm 

Step1 Initialize the pins of the microcontroller. 

Step 2 Define parameters like gains, K, P, I, D 

Step 3 Input the desired speed 

Step 4- Calculate the count per second “t” for the desired speed in one revolution 
Step 5- Assign interrupts for the counts 

Step 6- Receive the feedback from the encoder for time “t” 

Step 7- Compare the desired speed and feedback for time “t” 

Step 8- Calculate the error using the PID general formula 

Step 9- compare the error with the set gain 

Step 10- Generate PWM using respective gains and errors as base PWM 
Step 11- Run the entire step in loop. 


3.2. LQR controller 

Although the PID controller worked on the SSMR and showed an acceptable mobility, it was 
flawed. The idea of linear feedback proved to make the SSMR unable to move under varying terrain 
conditions. To overcome this problem, LQR controller was implemented on the SSMR. LQR is an optimal 
controller as it provides the smallest possible error in its output when compared to the input. The later 
controller design was optimally in paper [1]. By taking all the parameters needed for feedback model, drive 
model and dynamic model as derived in paper [1][2] further analysis were imbued in the Mbed LPC1768 
microcontroller. The block diagram of LQR controller as shown in Figure 10. 





Figure 10. Block Diagram of LQR Controller 


3.2.1. Dynamic model 

The dynamic model consists of the state space evaluation of M, C, R, and B are formulated (7-10) 

= m 0 

oan [o mx? o) 

=| aa | (8) 
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= F< (q) 
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(10) 
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Here, m is the mass of the body, @ is the orientation of the robot with respect to the global coordinates. 
Using all these values, we substitute them in the state equation (11). 


= M~*(q)B(q)t — M-+(q)Cn — M+ (q)R(q) (11) 


Where, M is the inertial force being experienced by the body of the robot, B is the input transformation 
matrix, 7) is the state matrix for any instance and T is the torque on the system. 


3.2.2. Overall state space model 
Although the dynamic and drive model are realized, the entire system calculation have to be done by 


involving both the dynamic and drive equations. This idea was well explained in the paper [1], while trying 
to device an optimum state space for simulation as shown in (12). 


A vy 

o| _ w Vi 

tail fi lat weed a TA (12) 
la2 la2 


Here, A; is a 4x4 matrix representing the Wheel Load Constants, Bı is a 4x2 matrix representing Voltage 
Conversion Constant and D is a disturbance, which is of the order 4x1. The constants are in the form of 
a state space, which keep changing with respect to Xıcr as shown in (13-15). 
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La 1 
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—Frx 
m 
—x1CRFry—Mr 
= | mxp (15) 
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These 4xN matrices are reduced to 2xN matrix by assuming L, to be zero since it does not make any changes 
for the arguments as shown in (16-20). 


Upa = Rala + NKew; (16) 
Vy a Vy V4 + 
(= AGE) +8) 2 (17) 
2n*KiKe _ 
He mr*Rq *icRW 18 
~ | mxircrw —2n*c*KiKe (18) 
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nKi nKi 
mrRa mrRa 
B = —ncK; ncKi (19) 
rRa(mx?cp+I) rRa(mxĵcp+I) 
-Fryx 
m 
D= —x1ICRFry—Mr (20) 
mx?cp+I 
General form of the state space representation is as shown in (21): 
X= A(X) X + BU + D(X) (21) 
Where the system states are represented by (22): 
X=[|vx w]T (22) 
The control input vector U is represented by (23): 
U =[V1 V2] T (23) 


D(X) is considered as a disturbance. 


3.2.3. Design of LQR controller 

The LQR controller can be designed for a system in two different ways. Homogenous LQR 
Controller: This type of LQR control does not take disturbance in factor. This is helpful as it gives faster 
response when the system is designed to move even terrain. Non Homogenous LQR controller: This LQR 
controller considers disturbances and it is a approach that is more practical. It helps the SSMR or a system 
move in uneven terrains. In Figure 11 is design of controller. 
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Figure 11. Design of controller 

3.2.4. Homogenous LQR design 

Consider the state space representation of a system (24-25): 

x = Ax + Bu, (24) 

y=Cx (25) 
With x (t) ERn, 
U (t) ERm and the initial condition isx (0). 
Assuming that all the states are measurable and seek to find a state-variable feedback control law as shown in 


(26): 


u = -Kx (26) 
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Here, K is the feedback gain vector. The quadratic cost function defined by (27): 
J=(Ż) JE &TQx + uTRu) dt (27) 
The optimal feedback gain vector can be calculated by (28): 
K = R“tBTP (28) 
Where P is the solution of the Algebraic Riccati Equation (ARE) defined by (29): 
ATP +PA+Q- PBR '!B!P=0 (29) 
3.2.5. Non homogenous LQR design 


The closed loop system equation of the controller is x = Ax + Bu. x=(A-BK)x. The function is given 
by (30-34): 


V(x)=xT Px (30) 
V =xTPx + xTPx (31) 
V=[(A — BK)x]’Px+x? P[(A — BK)x] (32) 
V=x"[(ATP + PA + Q—PBR7!B™P)-Q- PBR7!B'™P]x (33) 
V=x![-Q — PBR-1B'P]x (34) 


From V it is clear that R >0, P >0 and hence PBR7!B™P>0. Also Q >0. Hence (Q+ PBR7!B'P) >0. 
Therefore V< 0. Hence the closed loop system is stable. Control Solution (35-37): 


u=- R71BA (35) 
u=- R71B!(Px+K) (36) 
u= -R71B!Px -R-1B'K (37) 


It is observed from the equation that even after the present state x tends to zero there is a residual 
controller acting which tends to reduce the disturbance. 


3.2.6. Implementation of LQR on NXP LPC 1768 microcontroller 
LPC 1768 controller has a 32-bit ARM Cortex-M3 core running at 96MHz. It also has 512KB flash, 
32KB RAM and lots of I/O pins, which are required for the operation of SSMR. 
Algorithm 
Step Initialize the pins of the microcontroller. 
Step 2 Define parameters like gains, A, B, C, D, K 
Step 3 Input the desired speed 
Step 4 Calculate the count per second “t” for the desired speed 
Step 5 Assign interrupts for the counts 
Step 6 Receive the feedback from the encoder for time “t” 
Step 7 Compare the desired speed and feedback for time “t” 
Step 8 Calculate the gain matrices A, B, C, D, K, Q, R 
Step 9 Calculate the control unit u= (f+v)-Kx 
Step 10 Generate PWM using respective gains and errors as base PWM 
Step 11 Run the entire step in loop. 
*Note- D is taken as zero in case of homogenous LQR controller. 
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4. RESULTS 
Design Results of the Skid Steer Mobile Robot. Table 1 shows the final Electrical and Mechanical 


parameters of the SSMR robot. Detail Calculation of SSMRis given in APPENDIX—1. Table 2 shows 
the final results of the parameters of SSMR. 


Table 1. Electrical and Mechanical Parameters of the Robot 
Values (Dimension) 


Parameters 
R (radius of wheel) 0.1075 (m) 
M (Mass of Robot) 46 (kg) 
I (Moment of Inertia about COM) 0.006288 (Kg m°) 


R, (Armature Resistance) 0.317 (Ohms) 
K; (Torque Constant) 0.03 (Nm/A) 
K.(EMEF Constant) 0.03 (Vs/rad) 


a (Lateral distance of rear wheel center from COM) 0.2275 (m) 
b (Lateral distance of front wheel center from COM) 0.2275(m) 
c (Lateral distance between COM and the side wheel) 0.2275(m) 

-0.15 


Xicr (X coordinate of Instantaneous Centre of Rotation) 


Table 2. Final calculated Parameters of SSMR 


Parameters Value 
A 1.248 
B 10.83 
C 1 
D 0 
F 6.173 N 
K 1.54 
V 24 V 


4.1. Performance comparison result 
In Figure 11 is (a), (b) and (c) shows the response of PID and LQR-Homogeneous and 


non-Homogeneous Controller. 





(a) Response of PID Control (b) Response of Homogenous LQR Controller 


ia 


_ Wee 





c) Response of Non Homogenous LQR controller 


Figure 11. (a), (b) and (c) shows the response of PID and LQR-Homogeneous and non-Homogeneous 
Controller 
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From the results in Table 3, it isobserved that the LQR with Homogeneous Controller gives 
the better performance in settling time, peak amplitude and overshoot. 


Table 3. Performance Comparison 


Time Specifications PID LQR(H) LQR (NH) 
Settling Time 1.09 0.596 0.692 
Peak Amplitude 1.95 0.71 0.996 
Overshoot 13.1% 0.1366 6.1366% 


5. HARDWARE IMPLEMENTATION OF LQR ON SSMR USING NXP LPC 1768 
Both PID and LQR Controllers are implemented on the NXP LPC 1768 for the Skid Steering 
Mobile Robot and the performance comparison is made. The result in Table 4 demonstrates the following: 

a. The LQR Controller of the SSMR Robot has larger velocity than the traditional PID controller. 

b. The reference velocity of the system was set at 20 m/s, The LQR control gave practically very less 

loss in comparison to the PID Controller. 

c. Further observation shows that the velocity of all the wheels are the same for LQR Controller. 
Hence based on our theoretical modeling supported by Experimental results, it can be concluded thatLQR 
Controller is an Optimal Controller. Performance Comparison with Embedded Board NXP LPC 1768 as 
shown in Table 4. 


Table 4. Performance Comparison with Embedded Board NXP LPC 1768 


WHEELS 
Q4 Encoders CONTROLLERS LEFT LEFT RIGHT RIGHT 
FRONT REAR FRONT REAR 
PID 13 133 14.6 14.7 
VELOG LOR 15.9 15.9 16 16 
PID 29000 29000 29000 29000 
COUNTS LOR 29000 29000 29000 29000 
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APPENDIX 
Detail calculation of SSMR Robot is given below: 


_(0.125998 0.015 
a E 


A=1.2486 


B-( 0.7369 mene 
~\-7.3499 7.3499 


B=10.83 


= (0) 


C=] 


oct) 


D=39 


The gain matrix are obtained using Ricatti equation and matrices obtained from SSMR parameters 1.e. 
The value of Q matrix is 


T 


Therefore after solving the Ricatti Equation, the Gain Matrix is: 


_/1.2187 —0.6093 
Gor poe 


DC Motor 

Maxon DC motors are high-quality motors fitted with powerful permanent magnets. The “heart” of 
the motor is the worldwide-patented ironless rotor. This type of motor provides motor-gear head 
combinations for applications in extreme environments in terms of temperature, pressure also. The types of 
gear heads available are: Spur gear heads, planetary gear heads made of plastic, ceramic (zirconium 
dioxide and aluminum) or stainless steel. The motor used ishaving 12V power supply. The maxon motor as 
shown in Figure 1. 





Figure 1. Maxon Motor 


Hercules Motor Driver 

Hercules 6V-36V, 15Amp Motor Driver can take up to 30A peak current load and can be operated 
up to 10 KHz PWM. Motor driver can be interfaced with 3.3V and 5V logic levels. Motor driver has built-in 
protection from under/over voltage, over temperature and short. Motor Driver has optional ACS714 current 
sensor for current sensing. You can choose current sensor installation option at the time of placing the order. 
The Motor driver has terminal block as power connector and 10 pin 2510 type relimate connector for 
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the logic connection. It is suitable for high performance robots, Robocon, Robo-cup, US First, Battle robots 
levels. The Hercules motor driver as shown in Figure 2. 






PIN! 


LOGIC CONNECTOR 


PIN 10 


CURRENT SENSOR (Optional) r s "A MOTOR CONNECTOR 


Figure 2. Hercules Motor Driver 
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